Header header
int16 round
int16 agentID
geometry_msgs/Point[] control_points
bool bestPath
float32 interval
time traj_start_time
float32[] knots
float32 duration_time

time[] head_angle_knot_time
float32[] head_angle
